
#include "Control.h"


void controlTask(void)
{

    if(rc.sw2==RC_UP)
        send_shoot_zero_gimbal_moto_zero_current();

    else if(rc.sw2==RC_MI)
        send_shoot_zero_gimbal_moto_zero_current();
    else if(rc.sw2==RC_DN)
        send_shoot_zero_gimbal_moto_current(yaw_moto_current,pitch_moto_current);


}